N88-252C6 


(KASA-CE- 183031) ANALYSIS OF A 
C ICSID- KIKES A TIC CHAIN fiOEGI EA til PUIATOfi 
Scaiannual Beport (Catholic. Dei v... of 

America) 20 p. CSC1 09B Uadas 

G3/63 0148164 


SCHOOL OF ENGINEERING 
& ARCHITECTURE 



The Catholic University of America 
Washington, DC 2006^ 







A//KS''7&° 


THE CATHOLIC UNIVERSITY OF AMERICA 
SCHOOL OF ENGINEERING AND ARCHITECTURE 
DEPARTMENT OF ELECTRICAL ENGINEERING 


ANALYSIS OF A CLOSED-KINEMATIC CHAIN 
ROBOT MANIPULATOR 

By 

Charles C. Nguyen, Principal Investigator 
and Associate Professor 
Farhad J. Pooran, Research Assistant 


submitted to 
Mr. Timothy Premack 
Code 731.4 

Goddard Space Flight Center (NASA) 
Greenbe 1 t , Maryl and 


JULY 1988 


SUMMARY 


This report presents the research results from the research grant 
entitled: "Active Control of Robot Manipulators", sponsored by the Goddard 
Space Flight Center (NASA), under Grant Number NAG-780, obtained between 
January 1, 1 988 and June 30, 1988. 

In this report, toe concern with a class of robot manipulators built based 
on the closed-kinematic chain mechanism (CKCM). This type of robot 
manipulators mainly consists of two platforms, one is stationary and the other 
moving, which are coupled together through a number of in-parallel actuators. 
Using spatial geometry and homogeneous transformation, we derive a closed-form 
solution for the inverse kinematic problem of a six-degree-of- freedom 
manipulator, built to study robotic assembly in space. Iterative Newton 
Raphson method is employed to solve the forward kinematic problem. Finally 
the equations of motion of the above manipulator are obtained by employing the 
Lagrangian Method. Study of the manipulator dynamics is performed using 
computer simulation whose results show that the robot actuating forces are 
strongly dependent on the mass and centroid locations of the robot links. 


1. INTRODUCTION 


The in-parallel actuated manipulator whose design is based on the concept 
of closed-kinematic chain mechanism (CKCM) has recently attracted considerable 
research interest [3]— [11]. Because of its closed mechanism, this group of 
manipulators has several advantages over the conventional open-chain type. 
Manipulators with CKCM have smaller positioning errors due to the 
non-cant 1 lever 1 ike configuration and consequently have greater positioning 
ability, as compared to those with the open-chain type. Furthermore, they 
provide higher force/torque and greater payload handling capability for the 
same number of actuators. CKCM concept has been widely applied to design 
several industrial robots [10] -[11]. 

Implementation of the CKCM concept was first appeared in the design of 
the Stewart mechanism [1] consisting of two platforms driven by in-parallel 
actuators. After its introduction, the Stewart platform has been proposed In 
numerous robotic applications [2] -[4]. Yang and Lee [5] investigated the 
Inverse kinematic and workspace problems of the Stewart platform. Unlike the 
case of the open-chain type, manipulators with in-parallel actuators possess 
closed-form solutions to its inverse kinematic problem as learned by many 
Investigators. However, In most cases the forward kinematic problem must be 
solved iteratively using numerical methods. A general closed-form solution for 
this problem is not known at this time. Besides the forward kinematic 
problem, the dynamics of CKCM manipulators has also been an active research 
area. Due to its highly complicated mechanism, the dynamics of CKCM 
manipulators was not investigated as extensively as that of the open-chain 
type. Newton-Euler approach was employed by Do and Yang [6] to study the 
Inverse dynamics of CKCM manipulators. Sugimoto [7] combined the 
Newton-Euler approach and the so-called ''Motor Algebra " to analyze the 
kinematic and dynamical problems -of manipulators driven by in-parallel 
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actuators. Applying the Lagrangian approach, the dynamics of a 
two-degree-of -freedom and a three-degree-of -freedom CKCM manipulators was 
derived by Nguyen and Pooran [8] and by Lee and Shah [9], respectively. For 
control purposes, the Lagrange-Euler approach is more attractive than the 
Newton-Euler approach because it provides closed-form dynamical equations in 
any selected coordinate system. 

In this report, we concern with a closed-kinematic chain mechanism that 
was applied to build a si x-degree-of -freedom robot at the Goddard Space Flight 
Center (NASA) to study potential robotic applications In the space station 
[10]. In order to obtain an effective control scheme for this robot, the 
dynamics and kinematics analysis of CKCM robot manipulators should be 
performed. This report is structured as follows: First, we present a 
closed-form solution to the forward kinematic problem of the above type of 
CKCM manipulators by applying spatial geometry and the concept of homogeneous 
transformations. Then using Newton-Raphson Method, an Iterative solution is 
obtained for the forward kinematic problem. After that, the manipulator 
dynamics is derived by employing the Lagrangian approach. Finally, we present 
results of the computer simulation, performed to study the manipulator 
dynamics. 

2 . KINEMATIC ANALYSIS 

Figure 1 presents the structure of a si x-degree-of -freedom CKCM 
manipulator driven by 6 in-parallel actuators. The manipulator mainly 
consists of a stationary base platform and a moving platform coupled together 
through the actuators. Two coordinate systems are defined, the fixed 
Cartesian coordinate system {XYZ} whose origin Is at Point B, centroid of the 
base platform, and the moving coordinate system {xyz} whose origin is at Point 
C, centroid of the moving platform. The assignment of the above coordinate 
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systems complies with the right hand rules. A. and B { are the attachment 
points of the 1th actuator to the base and moving platforms, respectively. In 
this mechanism, there is a symmetric distribution of each pair of ball joints 
on the base and moving platform with respect to the three radii located at 120 
degrees apart from each other on the platforms. The coordinates of the 
attachment points B with respect to {XYZ) and A. with respect to {xyz> are 
given by 


B.= [ R cos(A.) 

R sin(A ) 0 ] T 

(1) 

-i i 

i 


and a.= [ r cos(A.) 

r sin(A.) 0 ] T 

(2) 


i i i 


where R and r are the radii of the fixed and movable platforms, respectively 
and a Is the position vector of the ball joints at A. with respect to {xyz}. 
A and A. are computed by 

A.= 60 (1-1) deg; A = 60 (1-1) deg, for 1= odd; (3a) 

A. = A. + 0 deg; A = A +0 deg, for 1= even, (3b) 

i i-1 B i i-1 A 

for 1=1,2 6. 

In (3a) and (3b), 0 and 0 are the angles between two consecutive ball 

A B 

joints at A. and B., respectively. 

2. 1 Inverse Kinematics 

The Inverse kinematic problem is formulated as to determine the required 

manipulator link lengths corresponding to a desired configuration (desired 

position and orientation) of the moving platform expressed In {XYZ}. The 

kinematic equations can be derived by considering the vector diagram for the 

ith actuator, Illustrated in Fig. 2. All vectors are expressed with respect 

to {XYZ}. Vector l = [t l t ] T can be expressed by 

-1 ix iy iz 

i, - e,- 5 , 

However 

B, = A ♦ d. (5) 
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Substituting (5) into (4) yields 


1= A.- B.+ d (6) 

-i -i -i 

In Eq. (6), vector A. represents the coordinates of the attachment points A. 
with respect to {XYZ>, while in Eq. (2) its coordinates is given by vector a 
with respect to {xyz}. If the orientation of Frame {xyz} with respect to 
Frame {XYZ} is specified by ZYX Euler angles (a B y), meaning that the 
orientation of Frame {xyz> is identical to that of a frame resulted after 
first rotating about the Z-axis an angle a, then about the Y-axis an angle B, 


and finally about the X-axis an angle y, then the corresponding rotation 


matrix is given by 


T = 


C C 0 

a B 

S C a 

a B 


-S 


0 


C S.S - s c 
a B 7 ay 

S S.S + C C 

a B 7 ay 

C e S 

0 r 


c s 0 c + s s 

a B 7 ay 

S S.C - c s 

a B 7 «y 

C-C 
0 7 


(7) 


where for compactness we have defined S = sin (a) and C = cos (a). Now since 

a a 

A { =Ta^ , we obtain from (6) 

l.= Ta. + d - B (8) 

-i -i - -i i 

In Equation (8), vectors a and B. are known fixed vectors, the desired 

- i - 1 

orientation and desired postion (the position of the origin) of the moving 

platform with respect to {XYZ} are contained in the rotation matrix T and 

the vector d, respectively where 

d = [x c y c z c ]'. (9) 

Therefore, using (8) Vector l. can be solved for a desired configuration of 

the moving platform. After solving for fi, the required corresponding lenght 

of the 1th actuator can be computed by 

t = (l, 2 + l. 2 + l 2 ) V2 (10) 

1 i x i y i z 

Defining vector ♦♦] T =IxyzaB7l T containing the 

i 2 3 4 5 6 

moving platform Cartesian configuration and vector l = [t 4 t t l l l 1 T 

* 1 2 3 4 5 6 


containing the six actuator lenghts as joint variables, the Jacobian matrix J 
of the manipulator which comprises the partial derivative of #. with respect 
to the joint displacements l. is defined as 

J= [ 9 $ ./at.]. (11) 

• l 

As we will see in the next section, there exist no closed form expressions of 
$ in terms of l because the forward kinematic problem must be solved 
iteratively. Therefore, the computation of the manipulator Jacobian matrix can 
be done by first using the inverse kinematic equation given by (10) to compute 
the inverse Jacobian as 

j' 1 = [8 l./d*.], (12) 

i J 

and then inverting the result obtained in (12). 

In order to prepare the dynamical analysis, we proceed to compute the 
angular velocity vector u defined by 

o = [u x t> Y o 2 ] T . (13) 

where o. denotes the angular velocity of the moving platform around the 1-axis 
of Frame (XYZ>, for 1 = X, Y, Z. Using the Euler Angles relationship and 
the rotation matrix in (7), it is simple to find the following: 

(14) 



Differentiating o, the angular acceleration is obtained by 
'-Spi - Cp<x£+ 7 

o = -S„S of) + C 0 C ay + C_S a - S Py + C 0 05) 

Pr P 7 P 7 7 7 

-S 0 C a £ - C 0 S ay + C.C a - C Py - S p 

Pr P 7 P 7 7 7 J 
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2.2 Forward Kinematics 


The forward kinematic problem Is formulated as to find the actual 

position and orientation of the moving platform when a set of actuator lengths 

l , t , .... I as joint variables are given. This situation occurs in the 

12 6 

case of position feedback in which the length information provided by six 
joint position sensors is to be converted into the actual conf iguration of the 
moving platform. With the information available, we are faced with a problem 
of solving six simultaneous nonlinear equations for six unknowns, namely x, y, 
z, a ,0 ,y . At the present time, no symbolic solution for this problem 
exists. Therefore, a natural way is to seek an iterative approach to solve the 
above problem. Among currently available numerical methods, Newton-Raphson 
algorithm is recommended to treat the above problem, as proposed in [11]. 
This method consists of first defining a function of the unknowns, f($) such 


that 


where 


mi = 0 

§=[x y z a 0 y] T 


and f($) = [f (*) f (*)] 

*" 1 6 “ 

and iteratively applying the formula 

, = * - j; 1 ^*) 

-k+1 - k f -k 


(16) 

(17) 

(18) 

(19) 


where ’’J^, the Jacobian matrix of f is given by 

J f = [8f ( (*)/8« ] (20) 

until certain accuracy is met. 

To utilize the available information on the actuator lenght i., provided 
from the joint position sensors, we define the function f.(§) as 
f.(*) = l't. - Kl 2 (21) 

i - -i-i i a 

where If. I is the actual lenght of the 1th actuator provided from the Joint 

1 A 

position sensor mounted on the 1th Joint. Obviously we can see that (21) 


( 22 ) 


satisfies (16). Substituting (8) Into (21) yields 
f ,(4>) = (Ta.+ d-B . ) T (Ta +d-B ) - It. I 2 

i ~ -i - - 1 - 1 - - 1 ' i ' a 

For a given set of Initial conditions of #, first we compute (22) and then 

(19) using (20). Equation (19) is repeated until some predetermined 

convergence criterion (desired accuracy) is met. 

Two drawbacks of the Nevrton-Raphson method are discussed now. First, It 

requires a significant amount of computational time. Second, the evaluation 

of the Inverse Jacobian at each Iteration may create the singularity problem. 

One solution to the first problem Is to select an appropriate Initial estimate 

based on a design model estimated at the desired moving platform configuration 

(12]. This will reduce the number of iterations and also save some 

computation time for convergence. The singularity problem can be avoided by 

modifying the robot trajectory planner. 

3. dynamical analysis 

The Lagranglan formulation describes the behavior of a dynamic system In 
terms of work and energy stored In the system rather than of forces and 
moments of the Individual members Involved [13]. Using this approach, the 
closed-form dynamical equations can be derived systematically In any selected 
coordinate system. The general form of Lagranglan equations of motion for an N 
degree-of -freedom manipulator is 

T = d/dt ( 3L/8q . ) - 3L/3q. (23) 

where L = K-P ' (24) 

q { Is the generalized coordinates, and x Is the generalized force or torque. 
K denotes the kinetic energy and P the potential energy . The total kinetic 
energy of the manipulator consists of the kinetic energy of the moving 
platform (translational and rotational motion with respect to the base 
coordinate system (XY2>) and the kinetic energy of the links due to the 


rotational motion of the link about the ball joints and the translational 





motion of the prismatic joints. Thus 


23 6 .2 .2 

K = — MV + - £ I<j+!z (m re. + m t 

2 C 2 J-1 ‘ 1 2 i.1 " • ' ’ 


(25) 


where M is the mass of the moving platform, m the total mass of Link 1, and m. 
the mass of the moving parts of Link 1. The angular velocity and the moment 
of inertia of the moving platform about the J axis are denoted by o and I. , 
respect! vely, for j=x,y, and z. In (25) . is the distance between the center 

of each link and the ball joint at B . The velocity vector of Point C is given 
by 

V c = <x c , y c . i e ) (26) 

Similarly, the total potential energy of the manipulator consisting of the 

potential energy of the moving platform and the links is given by 

6 

P = Mgz + mg £ l .sin(0.) (27) 

P . . Cl 1 

i=1 

where the angle formed between Link 1 and the base platform surface Is 
represented by 0. whose sine function is 

sin(0.) = t /t (28) 

i i z i 


Substituting (25) and (27) Into (24) and applying (23), we obtain after some 
mathematical manipulations the following equations of motion for the CKCM 
robot manipulator: 




. 3e , 

2 m 0 i( • Ki^t 
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- m.t 


1 i 3$ 


a i. at 

i c i 

+ mg 


ae. > 

i i 


j 


— sin0.+ mgt .cos0. ~ZT~ 
i ci i 34. 
J J 



(29) 

where It is noted that (29) is derived for the generalized coordinates * . 
In (29) for compactness, the notation k is used to indicate Cartesian 
coordinates such that x^ and stand for x, y, and z, respectively, and 
x i , x^, and x^ stand for x,y, and z, respectively, etc. Similar notation is 
used for J = 1,2,... 6 to indicate the Cartesian configuration x, y, z, a, 0, y such 
that for example, x 1 and x^ stand for x^ and x , respectively. It is also 
noted that Equation (29) represents the relationship between the generalized 
force/torqe x applied to the manipulator and the corresponding generalized 
coordinates 

j 

In order to determine the actuating forces F along the links, the 

virtual work concept is used [13] where the relationship between the joint 

force F. and the generalized force x. Is found as 
i i 

F = J T x (30) 

where J is the Jacobian matrix of the manipulator whose inverse Is given in 
(12). Eqn. (30) represents the actuating forces in the links of a 
si x-degree-of -freedom manipulator having j actuators. In the above 
development, the Joint friction is assumed to be negligible. 

The above generalized equations were used to derive equations for 
kinematics and dynamics of a 2-degree-of -freedom CKCM robot manipulator. 
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Results showed that the derived equations for this special case are Identical 
to those derived by applying the Lagranglan approach to the robot [14]. This 
fact verifies the correctness of the generalized equations. 

4 . SIMULATION STUDY 

In order to gain some Insight of the manipulator behavior, the kinematics 
and dynamics developed In previous sections are now studied using computer 
simulation. The software packages System Simulation Language (SYSL) developed 
by E 2 Consulting and Mat lab developed by MatWorks, Inc were employed to 
simulate the robot motion and compute the required actuating forces. Using the 
Inverse kinematics, we first computed the time history of the actuator lengths 
to track a semi-circle on the x-y plane of the base coordinate system, 
described by x+y=(0.20) (see Fig. 3). The time history of the actuator 

lenghts were then applied to the dynamical equations to compute the required 

actuating forces. Study of the Influence of the total mass and centroids of 
the links was performed and presented below where the system parameters used 
In this study were m=0.450 kg, m^.060 kg, M=4.500 kg, r=0. 18 m, R=0.45 m, 
0a=1O and 0b=11O degrees. 

Case 1: The mass of the links changed from .450 to 0 kg. 

The study results are recorded In Figure 4 where the solid line 

represents the profile of the actuating forces In Links 1 to 6 for m=0.450 kg 
and the dotted line for m = 0 kg. As the figure shows, link mass Increase 
results In force Increase which is expected In a dynamical system. 

Case 2: The link centroids described by lcl=a+bll, where a represents the 
system parameter and b was changed from 3cm to Ocm. 

The study results for Links 1 to 6 are showed in Figure 5 where the solid 
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line represents the case when b=3cm (original position) and the dotted line 
for b=Ocm. The results shows that moving the link centroids closer to the 
base frame reduces the required actuating forces. 

Case 3: The mass of the platform changed from 4.5 kg to 8 kg. 

The results are shown In Figure 6 where the solid line represents the 
profile of the actuating forces In Links 1 to 6 for M = 4.5 kg and the dotted 
line for M = 8 kg. It Is seen that Increasing the mass of the platform will 
Increase the actuating forces. 

5 . CONCLUSIONS 

In this report, the analysis of kinematics and dynamics of a 
slx-degree-of -freedom In-parallel actuated manipulator was presented. This 
type of manipulator Is built based on the CKCM that consists mainly of two 
platforms coupled via a number of In-parallel actuators. A closed-form 
solution was obtained for the Inverse kinematic problem. Newton-Raphson 
Iterative method, was proposed to solve the forward kinematic problem. Using 
the Lagranglan approach, we derived a set of generalized dynamical equations 
that can be employed to derive equations of motion for CKCM manipulators 
having up to six degrees of freedom. Computer simulation was performed to 
study the effect of variation In link mass and link centroids. Simulation 
results showed that reduction In actuating forces can be achieved If the link 
mass Is reduced and/or the centroid is moved closer to the base frame. Future 
research Is directed to studying effective control schemes such as adaptive or 
learning for the trajectory and/or force control of the above CKCM robot 
manipulator. 
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